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(54) A collision avoidance and warning system. 

@ A collision avoidance and warning system for 
land vehicles including radar transmission and 
receiving apparatus for sensing the presence of 
objects within a spatial range relative to a ve- 
hicle, multiple target tracking apparatus receiv- 
ing an output from the radar transmission and 
receiving apparatus for tracking a plurality of 
targets sensed by the radar transmission and 
receiving apparatus, auxiliary non-radar target 
sensing apparatus and alarm decision ap- 
paratus receiving an input from the multiple 
target tracking apparatus and from the auxiliary 
non-radar target sensing apparatus for indicat- 
ing the alarm status of a target and providing an 
output indication to alarm generating ap- 
paratus. 
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FIELD OF THE INVENTION 

The present invention relates to collision avoid- 
ance and warning systems for land vehicles. 

BACKGROUND OF THE INVENTION 

There exists much literature relating to collision 
avoidance and warning systems for land vehicles. Ex- 
amples of such literature include the following refer- 
ences, the disclosures of which are hereby incorpo- 
rated by reference: 

Merrill I. Skolnik, Introduction to Radar Sys- 
tems , 1981, 2nd Edition, Chapter 3.3, FM-CW Ra- 
dars. 

Daniels, D. J. Radar for Hazard Warning , 18th 
International Symposium on Automotive Technolo- 
gies, May 30 - June 3, 1988. 

Radar Handbook , Merrill I. Skolnik, McGraw- 
Hill Book Company, 1970, particularly chapters 21 
and 25, pertaining to tracking radar and ground echo; 

Eli Brookner, Raytheon Company, Wayenad, 
MA, USA. Radar Technology , 1977, particularly 
chapters 9 and 26 on Fast Fourier Transforms and 
Kalman filters; 

Chandler, R. A. and Wood, Lockett E., System 
considerations for the design of radar beaching sen- 
sor , IEEE Trans, on Vehicular Technology, Vol. VT - 
26, No. 2, May 1977; 

Erwin F. Belohoubek, Radar Control for Auto- 
motive Collision Mitigation and Headway Spacing , 
IEEE Trans, on Vehicular Tech., Vol. VT-31, No. 2, 
May, 1982; and 

Nagy, Louis L Electromagnetic Reflectivity 
Characteristics of Road Surfaces , IEEE Trans, on Ve- 
hicular Tech. Vol. VT-23, No. 4 t Nov. 1974. 

Existing collision warning systems have not yet 
attained acceptance in the marketplace, due in part 
to their high false alarm rates, which causes them to 
become a nuisance to the driver. 

SUMMARY OF THE INVENTION 

The present invention seeks to provide an im- 
proved collision avoidance and warning system which 
identifies potentially dangerous targets, also termed 
herein objects, and is characterized by an acceptable 
false alarm rate. 

There is thus provided in accordance with a pre- 
ferred embodimentof the present invention a collision 
avoidance and warning system for land vehicles in- 
cluding: 

radar transmission and receiving apparatus for 
sensing the presence of objects within a spatial range 
relative to a vehicle; 

multiple target tracking apparatus receiving an 
output from the radar transmission and receiving ap- 
paratus for tracking a plurality of targets sensed by 



the radar transmission and receiving apparatus; 

auxiliary non-radar target sensing apparatus; 

and 

alarm decision apparatus receiving an input 

5 from the multiple target tracking apparatus and from 
the auxiliary non-radar target sensing apparatus for 
indicating the alarm status of a target and providing 
an output indication to alarm generating apparatus. 
In accordance with a preferred embodiment of 

w the present invention, the auxiliary non-radar target 
sensing apparatus includes a laser energy transmitter 
and receiver. 

Additionally in accordance with embodiment of 
the invention, the system also includes alarm gener- 

15 ating apparatus for providing an indication of alarm 
status to a vehicle driver. 

Preferably, the radar transmission and receiving 
apparatus includes plural radar antenna apparatus. 
In accordance with a preferred embodiment of 

20 the present invention, the plural antenna apparatus 
includes at least one antenna for sensing vehicle 
ground speed. 

Preferably, the plural antenna apparatus includes 
a plurality of antennas for target detection. 

25 In accordance with a preferred embodiment of 
the present invention, the plurality of antennas are ar- 
ranged such that their detection regions are distribut- 
ed in partially overlapping orientation in azimuth. 
Preferably, the radar transmission and receiving 

30 apparatus also includes apparatus for comparing the 
outputs of more than one of the plurality of antennas 
relating to a given object in order to define the angular 
position of the object with enhanced resolution. 
In accordance with a preferred embodiment of 

35 the invention, at least one of the radar transmission 
and receiving apparatus and the multiple target track- 
ing apparatus includes apparatus for distinguishing 
moving targets from stationary targets. 

Preferably, the multiple target tracking apparatus 

40 provides an output indication of the velocity vector of 
a plurality of moving targets. 

Additionally in accordance with a preferred em- 
bodiment of the present invention, the multiple target 
tracking apparatus includes apparatus for disregard- 
's ing targets whose velocity vectors do not fit within a 
predetermined profile. 

Further in accordance with a preferred embodi- 
ment of the invention, the apparatus for disregarding 
includes apparatus for disregarding targets whose 

so vectors do not fall within a danger envelope defined 
with respect to the velocity vector of a protected ve- 
hicle. Characteristics of the protected vehicle such as 
a velocity vector thereof are also termed herein "own" 
characteristics, such as "own velocity vector". 

55 In accordance with a preferred embodiment of 

the invention, the auxiliary non-radar target sensing 
apparatus includes laser apparatus for defining first 
and second generally vertical beam walls which de- 



3 EP0 544 

limit a range of protection with respect to a protected 
vehicle. 

Additionally in accordance with a preferred em- 
bodiment of the invention, the auxiliary non-radar tar- 
get sensing apparatus includes laser apparatus for 5 
defining a generally horizontal beam fan spaced from 
the roadway which at least partially delimits a range 
of protection with respect to a protected vehicle. 

Further in accordance with a preferred embodi- 
ment of the present invention, the system also in- 10 
eludes apparatus for sensing impaired operation of 
the auxiliary non-radar target sensing apparatus and 
for modifying the operation of the system in accor- 
dance therewith. 

In accordance with a preferred embodiment of 15 
the present invention, the apparatus for sensing and 
modifying includes apparatus for operating the radar 
transmitting and receiving apparatus in an occupancy 
probability sensing mode of operation. 

There is also provided in accordance with a pre- 20 
ferred embodiment of the present invention a collision 
avoidance and warning method for land vehicles in- 
cluding the steps of: 

radar sensing the presence of objects within a 
spatial range relative to a vehicle; 25 

multiple target tracking a plurality of targets 
sensed by radar; 

sensing targets by auxiliary non-radar sensing 
techniques; and 

receiving a multiple target tracking input and 30 
an auxiliary non-radar target sensing input and on the 
basis thereof indicating the alarm status of a target 
and providing an output indication to a driver. 

In accordance with a preferred embodiment of 
the present invention, the auxiliary non-radar target 35 
sensing step includes a laser energy transmission 
and reception step. 

Preferably, the radar sensing step includes com- 
paring the outputs of more than one of a plurality of 
antennas relating to a given object in order to define 40 
the angular position of the object with enhanced re- 
solution. 

In accordance with a preferred embodiment of 
the invention, at least one of the radar sensing and 
the multiple target tracking steps includes distin- 45 
guishing moving targets from stationary targets. 

Preferably, the multiple target tracking step pro- 
vides an output indication of the velocity vector of a 
plurality of moving targets. 

Additionally in accordance with a preferred em- so 
bodimentof the present invention, the multiple target 
tracking step is operative for disregarding targets 
whose velocity vectors do not fit within a predeter- 
mined profile. 

Further in accordance with a preferred embodi- 55 
ment of the invention, the step of disregarding in- 
cludes disregarding targets whose vectors do not fall 
within a danger envelope defined with respect to the 
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velocity vector of a protected vehicle. 

In accordance with a preferred embodiment of 
the invention, the auxiliary non-radar target sensing 
step includes defining first and second generally vert- 
ical laser beam walls which delimit a range of protec- 
tion with respect to a protected vehicle. 

Additionally in accordance with a preferred em- 
bodiment of the invention, the auxiliary non-radar tar- 
get sensing step includes defining a generally hori- 
zontal laser beam fan spaced from the roadway which 
at least partially delimits a range of protection with re- 
spect to a protected vehicle. 

Further in accordance with a preferred embodi- 
ment of the present invention, the method also in- 
cludes the steps of sensing impaired auxiliary non-ra- 
dar target sensing and modifying operation in accor- 
dance therewith. 

In accordance with a preferred embodiment of 
the present invention, the steps of sensing and mod- 
ifying include operating the radar transmitting and re- 
ceiving apparatus in an occupancy probability sens- 
ing mode of operation. 

BRIEF DESCRIPTION OF THE DRAWINGS 

The present invention will be understood and ap- 
preciated more fully from the following detailed de- 
scription, taken in conjunction with the drawing in 
which: 

Fig. 1 is a generalized block diagram illustration 
of a collision avoidance and warning system con- 
structed and operative in accordance with a pre- 
ferred embodiment of the present invention; 
Fig. 2 is a block diagram illustration of electro- 
magnetic radar transmitter and detector appara- 
tus useful in the embodiment of Fig. 1 ; 
Figs. 3Aand 3B are respective top view and side 
view simplified illustrations of some of the cover- 
age regions of the radar apparatus of Fig. 2; Fig. 
3C is a side view simplified illustration of another 
coverage region of the radar apparatus of Fig. 2; 
Fig. 4 is a more detailed illustration correspond- 
ing to Fig. 3A and illustrating the partially over- 
lapping regions of coverage of a plurality of radar 
antennas; 

Fig. 5 is a simplified block diagram illustration of 
FFT ranging apparatus forming part of the appa- 
ratus of Fig. 2; 

Fig. 6 is a simplified illustration of a technique of 
processing radar signals from the plurality of par- 
tially overlapping regions of coverage illustrated 
in Fig. 4; 

Fig. 7 is a simplified pictorial illustration of a max- 
imum danger box defined with respect to a mov- 
ing vehicle; 

Figs. 8A, 8B and 8C are respective top, side and 
front view illustrations of the maximum danger 
box of Fig. 7; 
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Fig. 9 is a block diagram illustration of electro-opt- 
ical laser transmitter and receiver apparatus 
forming part of the apparatus of Fig. 1; 
Fig. 10 is a graph representing the relative sen- 
sitivity of the laser transmitter and receiver appa- 
ratus and the human eye; 
Fig. 11 is a block diagram illustration of the mul- 
tiple target tracking subsystem forming part of 
the apparatus of Fig 1; 

Fig. 12 is an illustration of the operation of the 
multiple target tracking subsystem of Fig. 11. 
Fig. 1 3 is a block diagram illustration of the alarm 
decision apparatus forming part of the apparatus 
of Fig. 1; 

Fig. 14 is a flow chart illustrating operation of 
block 160 of Fig. 13; 

Fig. 1 5 is a simplified block diagram of the audio 
visual alarm sub-system forming part of the ap- 
paratus of Fig. 1; and 

Figs. 16A and 16B are drawings of an occupancy 
probability map and matrix which are employed 
under certain conditions by the alarm decision 
subsystem. 

DETAILED DESCRIPTION OF A PREFERRED 
EMBODIMENT 

Reference is now made to Fig. 1 , which illustrates 
in generalized block diagram form, a collision avoid- 
ance and warning system constructed and operative 
in accordance with a preferred embodiment of the 
present invention, which may be mounted on a pro- 
tected vehicle. 

The system comprises a vehicle steering angle 
sensor 10, such as a dynamically compensated 
DDASL-TAM7 magnetometer based on magnetic flux 
changes measurements. The system also comprises 
an electro-magnetic radar transmitter and receiver 
subsystem 12 which supply inputs to a multiple target 
tracking subsystem 14. Multiple target tracking sub- 
system 1 4 provides a target identification output to an 
alarm decision subsystem 16 which also receives an 
input from the electro-magnetic radar transmitter and 
receiver subsystem 12 and from an electro-optical 
laser transmitter and receiver subsystem 18. 

It is a particular feature of the present invention 
that dual mode sensing is employed in defining an 
alarm event It is a further particular feature of the 
present invention that laser apparatus is employed for 
this purpose. 

The output of the alarm decision subsystem 16 is 
provided to an audio-visual alarm subsystem 20, 
which may provide an audio, visual, or any other suit- 
able single or combined alarm output to the driver to 
warn him of an impending collision. The alarm indica- 
tion may be provided by any suitable conventional 
alarm indication technique. 

Reference is now made to Fig. 2 which illustrates 



in block diagram form FM-CW electromagnetic radar 
transmitter and receiver apparatus useful in imple- 
menting subsystem 12 of Fig. 1. As seen in Fig. 2, a 
ramp generator 30 provides a ramp voltage signal to 

5 a voltage controlled oscillator 32, such as a GDV-42, 
commercially available from Militech. Oscillator 32 
provides a modulating input to a power divider or di- 
rectional coupler 34, such as an Alpha 555A. 

The output of directional coupler 34 is supplied 

w via a ferrite circulator 36, such as an Alpha 160A, to 
a two-way multiplexing switch 38. The outputs of a 
two-way multiplexing switch 38 are supplied to an an- 
tenna 40, which is used for detecting ground speed of 
a protected vehicle in which the apparatus of Fig. 1 is 

15 installed. Outputs from multiplexing switch 38 are also 
supplied via a four-way multiplexing switch 42 to a 
four element antenna array 44, which is employed for 
angular identification and ranging of targets. 

It is appreciated that antenna 40 and antenna ar- 

20 ray 44 are used for both transmission and reception 
and their received signal outputs are supplied via re- 
spective switches 38 and 42 and via circulator 36 to 
a mixer 46 such as a MXP-42, commercially available 
from Militech, which also receives an output from 

25 power divider 34. Mixer 46 effectively compares the 
received signals with the transmitted signals for de- 
termining their frequency/time relationship. 

The output of mixer 46 is supplied via a low pass 
filter 48 and a video filter 50 to a video amplifier 52 

30 which provides an amplified output to an FFT ranging 
processor 54. Processor 54 provides output indica- 
tions of protected vehicle velocity and of target angle 
and target range, using a suitable technique such as 
a Fast Fourier Transform (FFT). 

35 A preferred embodiment of FFT ranging proces- 
sor 54 is illustrated in block diagram form in Fig. 5 and 
includes a clock and synchronizer 60, such as an Al- 
tera 5064, which preferably operates at 40 MHz and 
provides synchronizing clock outputs to the elements 

40 described hereinbelow. An analog video signal from 
video amplifier 52 (Fig. 2) is supplied to a an 8-bit ana- 
log to digital converter 62, such as a Sony CVA 
1056K. Converter 62 outputs via a 1 KByte FIFO 
memory unit 64, such as an IDT 7203, to a PDSP 

45 1 651 0 stand-alone FFT processor 66, such as a Ples- 
sey 16510, which operates as a spectrum analyzer. 

The output of processor 66 is supplied to a digital 
signal processor 68, such as a MOTOROLA DSP 
56116, which provides output indications of protected 

so vehicle velocity and of angle and range for each of a 
multiplicity of targets. A Doppler effect-type algorithm 
may be employed to compute vehicle velocity. 

It is a particular feature of the present invention 
that vehicle velocity is preferably computed by the 

55 system, rather than relying upon the velocity value 
provided by the odometer of the protected vehicle. 
The odometer value is inaccurate, particularly when 
the car wheels skid due to poor weather conditions or 
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other factors. The protected vehicle velocity is em- 
ployed by the apparatus of the present invention to 
distinguish static objects from moving objects. 

A sample technical specification for EMR 12 of 
Fig. 2 is as follows: 

RF frequency: 24 GHz 

Transmitted Power 20 mw 

Range: 1 .5 - 192 meters. 

Range resolution: 0.75 meters. 

Target velocity range: 0 - 299 kph. 

Maximum detectable range: 1 92 meters for an 
RCSof5m 2 

Angular resolution at 192 meters: 2 degrees. 

Maximum frequency deviation: 200 MHz. 

Sawtooth duration: 25 microsec 

Pulse repetition rate: 16.6 KHz. 
Reference is now made to Figs. 3A, 3B and 3C. 
Figs. 3Aand 3B illustrate the composite radar cover- 
age region of target sensing antenna array 44, while 
Fig. 3C illustrates the ground engaging radar cover- 
age region of antenna 40, which is used for determi- 
nation of the ground speed of a protected vehicle in 
which the system of Fig. 1 is installed. 

Fig. 4 illustrates in greater detail the makeup of 
the coverage region of antenna array 44, as shown in 
Fig. 3A, such that the individual coverage regions of 
each of the four antenna elements can be seen indi- 
vidually. It is seen that the individual coverage re- 
gions of each of the four antenna elements are locat- 
ed in side by side partially overlapping arrangement 
in azimuth. Preferably, angle alpha in Fig. 4 is approx- 
imately 1 5 degrees and angle beta in Fig. 4 is approx- 
imately 10 degrees. The field of view (FOV) gamma 
in front of the protected vehicle is approximately +/- 
15 degrees. 

Fig. 6 illustrates in even greater detail the inter- 
relationship between target detections in adjacent in- 
dividual antenna element coverage regions, which 
can be used to provide an indication of the angular 
position of a target. 

A preferred procedure for determining the angu- 
lar position of a target 55 is now described with refer- 
ence to Fig. 6. Fig. 6 illustrates individual coverage re- 
gions 56 and 58 of two antenna elements respective- 
ly. Target 55 is differentiated from other targets be- 
cause the range detected therefor differs from the 
range detected for other targets. Target 55 is identi- 
fied as a single target even though it is detected by 
two antenna elements, or more generally by up to 4 
antenna elements, because the ranges detected by 
each of the antenna elements are equal. 

When antenna element 56 is active, the intensity 
of the EM echo returning from target 55 is proportion- 
al to the length of segment OA in Fig. 6. When anten- 
na element 58 is active, the intensity of the EM echo 
returning from target 55 is proportional to the length 
of segment OB in Fig. 6. Because the shape of the 
beams 56 and 58 are known, the angular position of 



target 55 may be computed as a function of OA/OB. 

Referring back to Fig. 5, when antenna element 
56 is active, FFT processor 66 provides and stores 
data on the intensity of the target 55 and of all other 

5 targets, for all ranges. When antenna element 58 is 
active, the same data is provided and stored for an- 
tenna 58. The data from antenna elements 56 and 58 
are compared. Subsequently, FFT processor 66 pro- 
vides and stores the same data for a third antenna 

10 element (not shown) and the data for antenna ele- 
ment 58 is compared to the data for the third antenna 
element This process is repeated in order to allow 
comparison of data for the third and fourth antenna 
elements. Alternatively, data from three sequentially 

is active antenna elements may be compared. 

Reference is now made to Figs. 7, 8A, 8B and 8C 
which illustrate a pattern of laser beams which are 
generated in front of a protected vehicle 80 in which 
the system of Fig. 1 is installed, to define a protected 

20 region, termed herein a "maximum danger region 
(MDR)" or a "laser MDR". Targets which are detected 
within the maximum danger region are deemed dan- 
gerous to the protected vehicle. In accordance with a 
preferred embodiment of the invention, the pattern of 

25 laser beams includes a pair of spaced vertical fan 
beams 82 and 84 which extend generally parallel to 
the sides of the vehicle, preferably for a distance of 
about 50 meters. The pattern of laser beams also in- 
cludes a generally horizontal fan beam 86, which ex- 

30 tends generally parallel to the road surface at a height 
of approximately 0.5 meters, for a distance of about 
70 - 75 meters from the protected vehicle, and covers 
approximately +/- 1 degree. 

Referring back to Fig. 3A, the composite radar 

35 coverage region generated by target sensing antenna 
array 44 in front of protected vehicle 80 also defines 
a protected region, termed herein a "maximum dan- 
ger region (MDR)" or a "radar MDR". Targets which 
are detected within the laser or radar maximum dan- 

40 ger regions are deemed dangerous to the protected 
vehicle. More specifically, if weather conditions per- 
mit operation of laser antenna array 44, intrusion into 
the laser MDR is a preferred criterion of danger. If 
weather conditions do not permit effective operation 

45 of laser antenna array, intrusion into the radar MDR 
is employed as a criterion of danger. 

Fig. 9 illustrates electro-optical laser transmitter 
and receiver subsystem 18 of Fig. 1. Subsystem 18 
employs the laser beams 82, 84 and 86 for detecting 

so objects within the protected region in front of the ve- 
hicle 80. The apparatus of Fig. 9 is based on a proc- 
essing and control subsystem 90, typically employing 
an INTEL 8051 microprocessor. The INTEL 8051 mi- 
croprocessor may be programmed to digitally imple- 

55 ment a nonlinear maximum slew rate closed-loop fil- 
ter, described in the following document, the disclo- 
sure of which is incorporated herein by reference: 
Faibish, S. and Moscovitz, J. "A new closed-loop 
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nonlinear filter design", Proc. of the 1st European 
Control Conference, pp. 38 - 43, Grenoble, France, 2 
-5 July, 1991. 

Processing control subsystem 90 provides power 
and control signals to a pulse modulator circuit 92, 5 
which in turn provides a current signal to three laser 
beam emitters 94, 96 and 98, such as a laser diode 
RCA-C86091E, causing them to provide respective 
fan beams 82, 84 and 86. 

Emitters 94, 96 and 98 also provide a signal out- 10 
put via a fiber optic delay line 1 00 to an optical receiv- 
er 102, such as a InGaAS photodiode RCA-C30642E. 
Optical receiver 102 receives reflected light from 
beams 82, 84 and 86 and provides an analog output 
to a signal detecting amplifier 104, such as a TRANS 15 
IMPEDANCE amplifier circuit, manufactured by Ra- 
fael, POB 2082, Haifa. Signal detecting amplifier 104 
receives timing signals from processing and control 
subsystem 90 and provides logic signals thereto. 

Signal detecting amplifier 104 also interfaces 20 
with a time of flight discriminator 1 06 which may com- 
prise a fast comparator LM-161, commercially avail- 
able from National, a passive time to voltage conver- 
ter and a 1 0 bit A/D converter AD-571 , commercially 
available from Analog Devices. Time of flight discrim- 25 
inator 106 provides a time of flight output, identifying 
targets impinged upon by one or more of the beams 
82, 84 and 86, to the processing and control subsys- 
tem 90. The subsystem 90 is operative to provide 
range data output information for targets impinged 30 
upon by beams 82, 84 and 86 to alarm decision sub- 
system 16 (Fig. 1). 

Asample mode of operation of subsystem 90 and 
the components of Fig. 9 which are associated there- 
with is as follows: 35 

The software portion of subsystem 90 receives a 
start/reset command from the central processor of 
subsystem 90 and generates a digital trigger signal 
which is provided to pulse modulator circuit 92. Sub- 
system 90 receives light signals M, L and R. These 40 
signals indicate that one of the walls of the laser MDR 
has been touched or encountered by an object, as ex- 
plained herein. 

Subsystem 90 also generates a status byte which 
indicates various possible states of laser subsystem 45 
18, such as erroneous measurements, no target in 
field of vision, or malfunction of transmitter. The cen- 
tral processor of subsystem 90 receives 1 byte data 
from time of flight processing unit 106 and computes 
a 2 byte long range value. Preferably, the value is so 
computed by dividing, each msec, the time of flight 
value by 6.6 nsec/m, corresponding to half of the ve- 
locity of light. 

The resulting range data is filtered using the 
above-described maximum slow rate nonlinear 55 
closed-loop filter which filters each range measure- 
ment independently rather than averaging several 
range measurements. The noise derivative of the fil- 



ter is very large whereas the signal has low limited 
derivative values. The 2 byte filtered range data and 
the laser subsystem status byte are employed to gen- 
erate a signal which arrives at the central processor 
of subsystem 90, using a RS232 serial communica- 
tion protocol each 50 msec. 

Fig. 10 provides a graphic comparison between 
the sensitivity of the laser beam transmitter and re- 
ceiver subsystem 18, represented along the vertical 
axis, and the vision capability of the human eye, rep- 
resented along the horizontal axis. Subsystem 18 is 
compared to the human eye for two laser wave- 
lengths, 1.5 micrometers (graphs A and D) and 0.85 
micrometers (graphs B and E), and for two types of 
objects to be detected: objects with retroreflective 
properties (graphs A and B) and objects without ret- 
roreflective properties (graphs D and E). Sample ob- 
jects with retroreflective properties are the retrore- 
flective papers used in the rear of cars, cat eyes, and 
road indicators. 

Graph C is a theoretical curve along which the 
detection range of the laser subsystem 18 is equal to 
the detection range of the human eye. Graphs A and 
B are above graph C, indicating that for objects with 
retroreflective properties, the laser detection range is 
greater than the detection range of the human eye. 
In graphs A and B, the SNR (signal to noise ratio) is 
33 db, because the returned light is amplified and the 
noise is not amplified. Graphs D and E are below 
graph C, indicating that for objects without retrore- 
flective properties, the laser detection range is less 
than the detection range of the human eye. In graphs 
C and D, the SNR is 10 db, less than for retroreflec- 
tive objects. 

It is noted that the detection range of the human 
eye is diminished by poor weather conditions such as 
fog and rain. 

Reference is now made to Fig. 11 which is a block 
diagram illustration of multiple target tracking subsys- 
tem 14 of Fig. 1. Inputs representing the velocity of 
the protected vehicle 80 and the ranges and veloci- 
ties of targets identified by the radar subsystem 12 
are received by apparatus 110 which is operative to 
compute the relative locations of the targets in Car- 
tesian coordinates. The x,y coordinates of the targets 
are supplied via a statistical 2-dimensional filter 112 
to a congruent target points selector 114, which is op- 
erative to determine which detected points are con- 
gruent. Congruent points are points along the same 
target and can be identified by determining whether 
the position and velocity vectors of a plurality of points 
are characteristic of a single target or of two or more 
closely spaced targets. 

The operation of congruent target points selector 
114 may be based on maximum likelihood or least 
square error estimation methods such as those de- 
scribed in A. Gelb, Applied Optimal Estimation, MIT 
Press, 1974, the disclosure of which is incorporated 
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herein by reference. Congruent target points selector 
114 also receives delta V x , delta V y outputs for each 
identified target from a relative velocity estimator unit 
which receives range and angle signals for each tar- 
get from radar subsystem 12. 5 

The congruent target points selector 114 pro- 
vides, for each identified target, its location in x, y co- 
ordinates and a (delta V x , delta V y ) vector represent- 
ing the x,y coordinates of the velocity of the individual 
target relative to the protected vehicle. These outputs 10 
as well as an input of the velocity of protected vehicle 
80 are supplied to a standing targets detector 118, 
which may comprise a unit for discriminating relative 
velocity. Standing target detector 118 identifies and 
provides an index of static objects. 1 5 

A Kalman filter bank tracking system 120 is pro- 
vided, such as the system described in Y. Bar-Sha- 
lom, Ed., Multitarget Multisensor Tracking: Advance 
Applications, Artech House publishers, 1990. Kalman 
filter bank 1 20 receives the output of selector 114 and 20 
an input representing the steering angle, theta, of the 
vehicle 80 from sensor 10 (Fig. 1). The Kalman filter 
is operative to predict the relative positions of the pro- 
tected vehicles and targets in its vicinity, after a time 
interval t of typically one second. Kalman filters are 25 
described in the above referenced publication by A. 
Gelb, the disclosure of which is incorporated herein 
by reference. 

A relevant targets selector 122, such as a go-no 
go logic switching system, receives the output of the 30 
Kalman filter bank system 120 as well as the output 
of standing targets detector 118 and provides an out- 
put indicating the position and velocity vectors of 
each of a predetermined number, such as 10, of the 
most dangerous objects in the field of vision. The out- 35 
put of detector 118 is provided to apparatus 124 for 
predicting future target position. The output of appa- 
ratus 124, expressed as X P ,Y P , is supplied to alarm 
decision subsystem 16, which is illustrated in Fig. 13. 
Relevant target selector 122 also provides feedback 40 
to Kalman filter bank system 120. 

The operation of the apparatus of Fig. 11 will now 
be briefly explained with reference to the illustration 
of Fig. 12. The apparatus of Fig. 11 is operative to 
track a plurality of n targets relative to a protected ve- 45 
hide moving at a velocity of v 0 . The position and ve- 
locity of each object is estimated by a single Kalman 
filter of the bank 120. The positions and velocities 
may be represented in a Cartesian coordinate system 
such as the Cartesian coordinate system of Fig. 12 50 
whose origin is the middle of the protected vehicle. 

Fig. 12 represents a typical highway scenario in- 
cluding 7 targets. Trajectories of each of the 7 targets 
for a predetermined future time period such as one 
second are indicated in broken lines. 55 

Reference is now made to Fig. 13 which illus- 
trates the alarm decision subsystem 16 of Fig. 1 . The 
Xp,Y p input from the multiple target tracking subsys- 



tem 14 (Fig. 11) is supplied to a unit 150 which sorts 
targets or objects by collision probability. Target sor- 
ter unit 150 outputs to future possible collision warn- 
ing unit 152, and to a warning conditions generator 
154, both of which also receive an input Rl from laser 
subsystem 18. The laser subsystem 12 also provides 
outputs Rl, M, L, and R to a unit 156 for indicating the 
presence of an object in the maximum danger region 
defined by the laser subsystem 18. 

The target range, target angle and protected ve- 
hicle velocity outputs from radar subsystem 12 are 
supplied to a unit 158 for indicating the presence of 
an object in the maximum danger region defined by 
the radar subsystem 12. 

The outputs of apparatus 152, 154, 156 and 158 
are all supplied to warning decision logic apparatus 
160 which is operative to provide an alarm warning 
signal to subsystem 20. 

A preferred logical sequence for warning deci- 
sion logic apparatus 160 is described in flowchart 
form in Fig. 14. seen in Fig. 14, data from the electro- 
optical laser sensor apparatus 156 provides a warn- 
ing indication which is used for generating an alarm 
signal (LIW) having decreased false alarms. If the 
LIW signal is "1 i.e. the laser has detected an object 
in the maximum danger box (MDB), an inquiry is 
made as to whether the multiple target tracking sub- 
system (MTT) is aware of the object. 

If it is determined that the object constitutes a 
danger to the vehicle, a weak alarm signal is gener- 
ated. If not, the range to the object, supplied by the 
laser sensor, is classified. If the range is greater than 
the estimated distance traveled by the object in T sec- 
onds, a weak alarm signal is generated. If the range 
is less than the previously defined distance, a strong 
alarm signal is generated. 

If, however, the trajectory of the object crosses 
the MDB and leaves the MDB, there is no danger and 
no alarm is generated. If the MTT did not designate 
the object as a danger, such as because of a small 
probability of collision, the object continues to be 
tracked by a Kalman filter. If the object subsequently 
constitutes a danger, a strong alarm is generated be- 
cause the initial evaluation of the MTT was incorrect. 

If the specific object is unknown to the MTT and 
the range to it measured by the EO laser is less than 
40 meters, a strong alarm signal is generated. Such 
an occurrence could represent a person crossing the 
MDB in front of the vehicle. Otherwise, if the range is 
between 40 and 60 meters, a weak alarm signal is 
generated. 

In cases where no object is detected in the MDB 
by the EO laser, a check is made whether the radar 
has detected any intrusion in the MDB. This is partic- 
ularly important in bad environmental conditions 
when the field of view of the EO laser system is lim- 
ited or when the EO laser system's vision is obstruct- 
ed, as by dirt. In the second instance, the false alarm 
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probability increases because of the limited angular 
resolution of the radar sensor subsystem 12 as com- 
pared with the laser sensor subsystem 18. 

In order to enable the radar subsystem 12 to be 
employed alone in situations characterized by accept- 
able false alarm rates, a virtual box overlapping the 
MDB is defined and an occupancy probability matrix 
is associated therewith as explained hereinbelow in 
connection with Figs. 16Aand 16B. 

In cases where the radar sensor detects an ob- 
ject, the decision scheme is identical with the case 
when the laser sensor has detected an object 

When neither the laser sensor nor the radar sen- 
sor has detected an intruder in the MDB, If there is 
any object in the field of view FOV representing a real 
danger, i.e. producing a collision probability of "1", a 
strong alarm signal is generated. If the collision prob- 
ability of the closest object in the field of view tracked 
by the MTT has a collision probability close to but 
smaller than "1", a weak alarm signal is generated. If 
the maximum collision probability, for all objects in the 
FOV, is less than a given threshold value, no alarm 
signal is generated. 

Fig. 15 illustrates a preferred embodiment of the 
audio-visual alarm subsystem 20 (Fig. 1). The sub- 
system preferably includes a driver warning signal 
generator 180 which receives the output of warning 
decision logic 160 (Fig. 13) and provides an output to 
an audio transducer 1 82 and well as an additional out- 
put to a visual display 184. 

Visual display 184 is preferably configured for 
displaying the intensity of the warning to the driver. In 
the illustrated embodiment, visual display 184 in- 
cludes a green display area, corresponding to a "no 
alarm" state, a yellow display area, corresponding to 
a "future risk" or weak alarm state, and a red display 
area, corresponding to an "imminent danger" or 
strong alarm state. Visual display 184 also has indi- 
cators 186, 188 and 190 for indication of POWER ON, 
SELF TEST and LASER FAILURE respectively as 
well as corresponding manually operable switches 
192, 194 and 196. 

Reference is now made to Figs. 16A and 16B 
which conceptually illustrate a preferred method for 
determining whether or not laser subsystem 18 has 
failed to give an indication of the presence of an ob- 
ject in the maximum danger region. The method of 
Figs. 16A and 16B may be implemented by any suit- 
able unit, such as unit 158. 

As shown in Fig. 16A, according to a preferred 
embodiment of the present invention, the radar sub- 
system 12 is employed to determine the range of the 
closest object in each of a plurality of directions. This 
information is preferably employed to determine 
whether any of the objects detected fall within the 
maximum danger region, which generally indicates 
malfunction on the part of laser subsystem 18. There- 
liability of the information regarding the presence of 



an object in the MDR, as well as the probability that 
the object would collide with the protected vehicle, 
are preferably taken into account when assessing the 
function of laser subsystem 18. For example, if the ra- 

5 dar subsystem provides a relatively reliable indication 
of an object within the MDR, and this object was not 
detected by the laser subsystem, then it is relatively 
probable that the laser subsystem is malfunctioning, 
due to weather conditions or for other reasons. 

w Fig. 16B illustrates a matrix indicating the level of 

confidence that an object is in fact a danger, in a sit- 
uation where an object has been detected by the ra- 
darsubsystem at a particular angle and at a particular 
range^ Densely shaded elements of the matrix indi- 

15 cate angle and range pairs for which there is a high 
level of confidence that an object is present at the lo- 
cation indicated. Sparsely shaded elements of the 
matrix indicate angle and range pairs for which there 
is a low level of confidence that an object is present 

20 at the location indicated. 

It will be appreciated by persons skilled in the art 
that the present invention is not limited by what has 
been particularly shown and described hereinabove. 
Rather the scope of the present invention is defined 

25 only by the claims which follow: 



Claims 

30 1. A collision avoidance and warning system for 
land vehicles comprising: 

a radar transmitter/receiver forsensing the 
presence of objects within a spatial range relative 
to a vehicle; 

35 a multiple target tracker receiving an out- 

put from said radar transmitter/receiver for track- 
ing a plurality of targets sensed thereby; 

an auxiliary non-radar target sensor; and 
an alarm activator receiving an input from 
40 said multiple target tracker and from said auxili- 

ary non-radar target sensor for indicating the 
alarm status of a target and for providing an out- 
put indication to alarm generating apparatus. 

45 2. A system according to claim 1 and wherein said 
auxiliary non-radar target sensor comprises a 
laser energy transmitter and receiver. 

3. A system according to either of claims 1 and 2 
50 and also comprising an alarm generator for pro- 
viding an indication of alarm status to a vehicle 
driver. 

4. A system according to any of the preceding 
55 claims and wherein said radar transmitter/receiv- 
er comprises plural radar antenna means. 

5. A system according to claim 4 and wherein said 
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plural antenna means includes at least one anten- 
na for sensing vehicle ground speed. 

6. A system according to either claim 4 or claim 5 

and wherein said plural antenna means includes 5 
a plurality of antennas for target detection. 

7. A system according to claim 6 and wherein said 
plurality of antennas are arranged such that their 
detection regions are distributed in partially over- 10 
lapping orientation in azimuth. 

8. A system according to claim 7 and wherein said 
radar transmitter/receiver also comprise an an- 
tenna output inspector for comparing the outputs 
of more than one of said plurality of antennas re- 
lating to a given object in order to define the an- 
gular position of said object with enhanced reso- 
lution. 

9. A system according to any of the preceding 
claims and wherein at least one of said radar 
transmitter/receiver and said multiple target 
tracker includes a target motion detector for dis- 
tinguishing moving targets from stationary tar- 
gets. 

10. A system according to any of the preceding 
claims and wherein said multiple target tracker 
provides an output indication of the velocity veo 30 
tors of each of a plurality of moving targets. 
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